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ABSTRACT 


This paper covers the design of a dynamic positioning system for the U.S. Coast Guard 
WLB “IRIS” class buoy tender. The control system design is based upon optimal con- 
trol theory with estimates of position and heading provided by a steady state Kalman 
filter. Sea current estimates are provided by a Kalman filter predictor based upon the 
innovations process. The vesscl and dynamic positioning system are simulated using the 


Dynamic Simulation Language (DSL). 


THESIS DISCLAIMER 


The reader ts cautioned that computer programs developed in this research may not 
have been exercised for all cases of interest. While every effort has been made, withmn 
the time available, to ensure that the programs are free of computational and logte er- 
rors, they cannot be considered validated. Any application of these programs without 


additional verification is at the risk of the user. 
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I. INTRODUCTION TO DYNAMIC POSITIONING SYSTEMS 


A. DEFINITION : 

A dynamic positioning system (DPS) is an automatic control system that will drive 
a vessel to a Selected position and maintain that position and selected heading using 
computer control of propulsive thrusters. A DPS includes one or more position and 
heading measurement systems and a computer-directed control system. The system 
should keep the vessel within its specified position and heading constraints with optimal 


use of propulsors, reducing the wear on that machinery. 


B. ADVANTAGES AND DISADVANTAGES 

The use of DPS is not new. The first dynamic positioning systems appeared in the 
late 1960's on coring, cable laying and surface-support ships for underwater work. The 
success of these initial DP vessels spread the application of the systems into offshore oil 
industry, dredging, precision dumping, pipe laying, and floating hotels. 

‘There are several advantages of dynamic positioning over anchor deployment. It is 
usable in all water depths and not constrained by the length of its anchor chain. In 
contrast to anchoring, there is virtually no set-up time required to begin stationkeeping. 
In order to reach and attain a precision position by anchoring, time and personnel in- 
tensive anchoring details must be set. A DPS allows a vessel to attain virtually any po- 
sition and heading automatically. Due 10 its dvnamic nature, a DPS vessel can work in 
close quarters with fixed platforms or anchored vessels. A dynamic positioning systein 
is designed to operate in adverse weather conditions 

The disadvantages of DPS include high initial capital investment, high fucl costs 
(over anchoring), high maintenance due to the continuous activation of thrusters, and 
increased manpower requirements for maintenance. 

Dynamic positioning is an effective means of stationkeeping when water depth is too 
great for anchoring, on-station time will be brief, the vessel is required to be on station 


in all weather conditions, and accuracy in positioning is more important than cost. 


C. EQUIPMENT FOR DYNAMIC POSITIONING SYSTEMS 
The equipment needed for a dynamic positioning system includes a wind sensor 


(velocity and direction), gyrocompass, and a position reference sensor. 


There are several position sensors that are employed in DPS designs. They include 
sensors that determine position, velocity and/or acceleration in some common reference 
system. The basic position sensor types are taut wire, optical, acoustic beacon, and ra- 
dio systems. A 

The taut wire scheme works by lowering a weight to the sea floor by wire rope. The 
wire is held in constant tension, usually by a constant-tension winch, and any angle de- 
viations from vertical are corrected by thrusters. 

Optical positioning systems are of either active or passive design and make use of 
laser technology. Triangulation of sextant angles provides position information. Ilow- 
ever, seXtants are manually trained by personnel. 

Acoustic beacon is the most common positioning system in the offshore industry. 
This system requires a sea floor beacon and hull-mounted subsurface hydrophones. 

In general, standard radionavigation systems such as Loran-C, OMEGA, and Tansit 
SATNAV do not provide sufficient accuracy for DP systems. The approximate accura- 
cies of these systems are: 

e Loran-C - 460 meters, 
© OMEGA - 500 meters, 


© SATNAY - 25 meters. 


(Refiel= p. o-13) 

Accuracies of those magnitudes are completely unacceptable for DP systems. The 
NAVSTAR Differential GPS, however, is able to provide accurate position information 
to within 3 meters anywhere on the globe. In addition, this system allows vessels to 
measure Velocity using Doppler to accuracies of about 0.1 meters per second. [Ref. |: 
p. 8-18]. 

For a ship to be dynamicallv positioned it must use thrusters, sensors, computer, 
and a control and display system. The thrusters must be able to provide fore and aft, 
athwartships, and moment control. Sensors provide physical information including po- 
sition, heading, and wind conditions. The computer uses sensor information and calcu- 
lates required thruster commands that will position the vessel at the reference position 
and heading. Controls and displays are required to allow the operator to monitor and 
control the DP system. 

The purpose of this thesis is to design and simulate a dynamic positioning svstem 


for a U.S. Coast Guard buoy tender. The dynamic positioning system is designed to be 


fully automated, perfornung its functions in varving sea states, wind. and current con- 


ditaons with its only operator input being the referenced position. 


Ht. BACKGROUND 


The U.S. Coast Guard has begun the acquisition process for seagoing and coastal 
buoy tenders to replace the aging 157 foot WLM class and the 180 foot WIB class 
tenders. See Figure | for a comparison of the old WLB fleet with its successor [Ref. 2: 
p.7]. One of the requirements for the replacement vessels 1s a dynamic positioning sys- 
tem. The dynamically positioned vessel must be able to approach, maneuver, and 
maintain position, within a circle of a 10 meter radius over a fixed point on the earth, 
alongside floating aids to navigation in restricted channels of shallow, 18 foot decp bays, 
estuaries, and rivers. The system is required to maintain position in a 30 knot wind of 
any aspect and 5 knot current within 10 degrees of ship’s head [Ref. 3: p. 15 J. This 
DPS design endeavors to take a modified existing U.S. Coast Guard (USCG) buoy 
tender using a nunimum of additional contro] and measurement inputs in order to reduce 
the potential implementation costs. This initial design 1s a 180 foot WLB “IRIS” class 
buoy tender. The only modifications to existing vessels are the installation of a stern 
thruster and Global Positioning System (GPS). The GPS provides real-time positioning 
information accurate to within three meters anywhere on the globe [Ref. I: p. 8-18 J. 
The GPS is a requirement of the replacement buoy tender fleet. The available controls 
for this design are 200 SI1P bow and stern thrusters and 1170 SI1P single screw propul- 
sion. System sensor measurements are GPS, gyrocompass, and wind inputs. The mul- 
tiple mission requirements of the buoy tender, as with all Coast Guard cutters, placed 
some constraints on the DPS design from the outset. The buoy tender is occasionally 
called upon to perform some harbor icebreaking duties. It is considered an ice-capable 
vesscl, able to break up to one foot of ice at three knots [Ref. 3: p. 15 J. lee operations 
preclude the use of subsurface position sensing devices such as hydrophones and taut 
wire schemes. In order to clarify the reasoning behind some of the system constraints, 


a brief qualitative description of buoy tending operations follows. 


A. BUOY TENDING OPERATIONS 

At the present time, buoy tending operations are at best an inexact science, as is the 
case in many shiphandling routines. The manual ship positioning techniques of experi- 
enced deck officers have been raised to an art form. Put simply, by the use of sextant 
angles or other “local” points of reference, the vessel is slowly aimed at its intended po- 


sition. As the distance to the desired location decreases, the engines are slowed or 


WLB CAPARILITIES 
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Figure 1. WLB Comparison. (From Ref. 2) 


stopped altogether. As the vessel crosses this desired location, the buoy is released in 
position and the vessel continues on. If, however, the vessel does not cross the desired 
buoy position, another pass must be made. As weather conditions deteriorate, this 
procedure can rapidly increase on station time. A dynamically positioned vessel can be 


programmed for a given location and heading. The DP vessel adapts to environmental 


changes and makes optimal use of thrusters to maintain position so it clearly has the 


advantage over the hit-or-miss scenario just described. 


Il. EQUATIONS OF MOTION 


The mathematical modeling of the “plant”, the waterborne vessel and its environ- 
ment, 18 divided into several parts: low and high frequency vessel models, wind model, 


and current model. 


aw. COORDINATE SYSTEM 

lor modelling purposes. two different coordinate systems are used. Earth-fixed co- 
Ordinate axes are used to integrate the dvnamic equations of motion. A vessel parallel 
set of axes, with the same origin as the earth-fixed axes, is used for computing the forces 
acting on the vessel. See Figure 2 for the relationship of these coordinate axes (Ref. 4: 


p.SS3]. The x and y axes represent the vessel in surge and swav and the angle y is the 


vessel vaw in degrees true. Ilence, heading angle is the same for both sets of anes. 





Figure 2. Coordinate Axes 


B. LOW FREQUENCY MODEL 

The equations of motion for a floating vessel in a seaway are highly coupled and 
non-linear. Figure 3 is a block diaqram of the low frequency (LF) motions of the vessel 
in surge, sway, and yaw. The low frequency model represents the dynamic response of 
the ship in “calm” water with wind, current, and propulsive force disturbances. The ef- 
fect of wave action is not considered here as that is modeled by the high frequency model 
below. The coupled non-linear differential equations for surge, sway, and yaw may be 


expressed as follows: 
x, = Ind OWr +m,VWp og |My Ce My eg ete lle ee (1) 
vim I fmalmyti =m (i, Ub, NB eNO — tol ae ln sell aa th hey (2) 


We = Ulm, — (my, —ray xp — WO, v0) -— dy [|e tM A, tg) + py, (3) 


where 
¢ x,,x,- LF surge position and velocity 
®* yr. J, - LF sway position and velocity 
« wW,,W,- LF yaw heading angle and angle rate 
° u,,¥,- Current velocities in surge and sway 


ce ve 


© F,.,F. 


wrt wy 


- Wind force in surge and sway 

« f,, f,- Prop and thruster forces 

e M,, M,, M,- Wind, thruster, and current moments in yaw 
© Are Ny. NW - Zero mean Gaussian White Noise Processes 
© 4d,,d,,d,- Coellicients ol Drag 


« m,,7,, m, - Effective Mass Terms 


Rel, 4: p, 85a] 


measurement 
noisc 


plant noise 





Figure 3. LF Model 


C. VESSEL CHARACTERISTICS 
As previously stated. the modelled vessel is a LSCG WLB “IRIS” class. The vessel 
1s considered to have the following characteristics: 
e Length (Overall) - 180 feer 
e Length (between perpendiculars) - 170 feet 


¢ Beam - 37 feet 


e Draft - 12 feet 
¢ Displacement - 943.5 L.Tons 
. = 71920 slugs 

147615 slugs s 
2.67x108 slug/?? 

e d, 169 slug/fi 

e d, = 869 slug/ft 


y 


ed, = 1.17x10 slugft/rad 


em 


® 
Ml, 


em, 


[Rel 3° spa hy] 

The effective mass (7, 11,, 7) terms are generated by a computer simulation known 
as the Standard Ship Motion Program (SMP). This program was developed at the 
David W. Taylor Naval Ship Research and Development Center. The SMP provides 
predictions of vessel motion in translation (surge and sway) and heading (yaw) in irreg- 
ular seas based upon strip theory. The effective mass is the sum of the vessel mass (the 
mass of water displaced by the vessel) and an “added mass” term. The added mass term 
is predicted by the SMP versus varying frequencies of wave encounter, o. Appendix A 
is the printout of the SMP for the 180 foot WLB buoy tender. The added mass and drag 
terms shown there are non-dimensional. These terms are a function of the frequency 
of encounter of wave motion, ¢, which is also non-dimensional. For purposes of this 
thesis, constant dimensronalized values of drag and mass are used, based upon an “av- 
erage” wave frequency of 1.1 radians per second which corresponds to Sea State 5 and 
an average wave height of 5.0 ff. However, the drag terms of the SMP cannot be di- 
rectly related to the LF equations of motion used here. The drag coefficients are derived 


directly from Bernoulli's equations for fluid ow on a moving object: 
F =1/2pU" (4) 


where p is the fluid density and U is the velocity of the fluid relative to the object. The 
drag terms are the product of the Bernoulli force terms with the effective underwater 
area of the vessel. By using the length between perpendiculars, beam, draft, and a block 
coefficient of 0.437, the drag terms are as listed above. Simulations using the [ODE 
software package confirm these values. See Appendix B for the simulation results. The 


vessel 1s simulated at zero sea state with maximum thrust. Using the effective mass 


10 
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D. HIGH FREQUENCY MODEL 


The hich frequency vesse? mothe! represents the heth frequenct wave action ci tite 


vessci Tibrec harmome escillatcrs are modelled in surge. sivay. and yaw wilt vanable 


frequenct. as Foliows 


¥an=—O80Sn + Fw. iG) 
—.— _® -- = r.- ia 
of = — aoe U rey 


“ =F§ i 1M 
ubere 
* xe x, - TI] eee postion and \efotis 
* got,- lif swanposiuie aml velenry 
@) O6.¢, - JIT vaw angle aml amelie rate 
° ey woe, - HD angular (reycnccs in Suse, stay, ant say 
© 2s 5 We. New bem - 2o7O Sreatt Gadssian Wate Nome Pradesses 


E. WIND MODEL 
The wittd is modelled as the sum cf Siowly varying. low mean frequency anu rapa 


Varun) Mell Freguenc. tists. botly in wind screed and direction. Thre equations [or the 
at Tf Stee Toyue: ~. ca | 5 C4 


: = - inj 
Shae amecc? are 


hi 


| Was = Nwds (13) 


Wa = Wa + Nay (14) 


where the model terms are defined as follows: 


e =6w,, - Slowly varying wind velocity 

e w,,- Rapidly varying wind velocity 
e =6w,, - Slowly varying wind direction 
e w,- Rapidly varying wind direction 


© Maver Must Nass Nvar > CETO Mean Gaussian White Noise Processes 


The wind force terms of equations 1, 2, and 3 are then defined by: 


Fux = Fy(B) ys + wy) (15) 
Fy = FB) ys hy) (16) 
My, = F3(B)(Wy, ty)" (17) 
: B = Wa + War — (Wi + Wy) (18) 
where 
e 6F,,, F.,, A, - Wind forces and moment 


e f£- Wind angle of attack 


¢ Ff, Ff, = Ellective wind suxiace areas 


[Ref. 4: p. 854] 
The F, terms are again derived from Bernoulli's equations for fluid flow. In this case 


the fluid is air and the area is the effective area of wind resistance of the vessel. 


F. CURRENT MODEL 


The current model is described by the following set of differential equations: 


XcE = xCE (19) 
Wen —er (20) 


Ver= WYCE (21) 


(ie = Bee cos Wy ae Wes sin Wy (22) 


y= —Xcee sin W + yee cos (23) 


with the terms defined as follows: 


© XceSce - Current velocities in earth coordinates (North and East respectively) 


e u,,¥,- Current velocities in surge and sway 


[Ref. 4: p. $54] 

These wind, current, high frequency, and low frequency models constitute the vessel 
“plant”. Each model represents a different aspect of the plant dynamics. It is clear, 
however, that the only model which may be controlled by the DP system is the low fre- 


quency model. 


IV. CONTROL SYSTEM DESIGN 


A. PROPULSORS » 

The design of the buoy tender control system is based on several constraints. First, 
there are only three propulsive forces available: the propeller for thrust forward and 
astern (+x direction, surge) and the bow and stern thrusters for moment control 
(+ Wdirection, yaw) and athwartships motion (+ y direction, sway). 

The bow and stern thrusters are 200 HIP fixed tunnel units. A good rule of thumb 
for the thrust developed by fixed azimuth tunnel thrusters is 30 frlbf/SHP. These will 
yield approximately 6000 pounds force in the + y direction. The bow thruster is located 
78.88 feet forward of the center of buoyancy and the stern thruster 1s 81.12 feet astern 
of it. See Figure 4 for the thruster layout. 


The force and moment equations for the bow and stern thrusters are thus: 
Flor SP (24) 
MT = 78.88BT — 81.12ST (25) 


whiere, 
e FT - Athwartships force due to thrusters 
e MT - Yaw moment due to thrusters 
e BT - Force of bow thruster 


e ST - Force of stern thruster 


It must be noted that athwartships force, FT, is assumed to be applied at a single point, 
the center of buoyancy. The moment force, MT, is applied about the center of 
buoyancy by the thrusters proportional to their output and the length of the moment 
arm. This length is measured from the center of buoyancy to the thruster. A positive 
moment is considered to be one which will make the ship turn to starboard, a negative 
moment to port. See Figure 4 for the thruster moment dimensions. 

The fixed pitch propeller is driven by a single 1170 SHP diesel electric power plant. 
It can normally produce upwards of 20,000 pounds force of thrust. The equation for the 


maximum thrust generated by the propeller is: 
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Figure 4. = Thruster Forces and Moments 
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max 


Assume a propeller efliciency, 7,,..=.75 and a maximum velocity, 7, = 14.3 Anors , this 


vields a maximum thrust FP,,, = 20,250 /1lbf, Ilowever, due to the nature of 


positionkeeping, the propeller controller was limited to 12,000 pounds force in the DP 
mode. 

The controller design is based onlv on the low frequency vessel inodel. Responding 
to the high frequency wave action of the vessel would cause the controllers to modulate 
in even moderate seas. 


The low frequency system was placed in state variable format, 
x=Ax+ Bu+ Gw (27) 
y= Cxt Duty (28) 


The non-linear, coupled A and B matrices are: 


() l 0 0 0 0 
QO =d,|x—u,| f/m, 0 my Jiny 0 ie 
0) 0 0) l 0) 0 
AS ; (29) 
0 <i, ip fm, 0 =e Vala 0 Th 
0 0 0 0 Q) ] 
SS myth linn, OF Cit, ) vai Oa, | ib | Jan, 
0 0 0 
I font, 0 0 
0) 0 0 
B= (30) 
0 I fin, I/m, 
0) 0 0 


0 78333 e=slal2 


The state observations matrix, C 1s: 


000 0 0 
C=|0 0 10 0 0 (31) 
O00 200 
The low frequency plant is linearized about 
u=V=Pex=yp=0 (32) 


and the vessel paraincters substituted to yield the linear A, B, and G matrices. 
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The plant noise matrix is: 


The state variable matrix 15: 
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(33) 


(34) 


(36) 


The control matrix ts: ; 


u=| BT (37) 


The Control Toolbox of the software package PC-MATLAB (for MS-DOS Per- 
sonal Computers, Version 3.2-PC June 8, 1987) is then used to obtain the feedback 
gains. Assuming full state feedback is available, the Iqr (linear quadratic regulator) 


function calculates the optimal feedback gain matrix K,,, such that the feedback law: 


opt 


U= — Kept (38) 
minimizes the cost function: 
J= [ores + u’ Ru)dt (39) 
where the state weighting matrix, Q is: 
3E04 0 0 0 0 0 
: 0 3E04 0 0 0 0 
0 0 6£04 0 0 0 
C= (40) 
0 0 0 6£05 0 0 
0 0 0 0 LE09 0 
0 0 0 0 0 biZ09 
and the control weighting matrix, R is: 
Po 0 
R=|0 1 0 (41) 
0 0 1 


The Iqr function returns the follawing feedback gains: 


34917 aa 0 0 0 
p= | 0 150 4434 24962 249962 (42) 
0 0 Ps 5/01 —19al5 —19415 


This places the eigenvalues of the closed loop linearized system at: 


—0.035 + j0.035 
—0.034 + j0.034 
a We (43) 


—3.6£06 


Since all the states are not available for feedback, an observer is utilized to provide 
an estimate of the states. A Kalman filter is designed with the aid of the PC-MATLAB 


function Ige (linear quadratic estimator). Recall the system: 
x=Ax+ Bu+ Gw (44) 
and 


TS Cee (45) 


Where the expected values of the plant noise, w, and the measurement noise, v, are 


E(w] = E[v] =0 and the covariance matrices for plant and measurement noise are, re- 


spectively, EL ws" J and ELrv' J. The covariance matrices are: 


EL ww" ] = 0.0005 (46) 
100 0 0 
Ev j=1-0 100 90 (47) 
0 0 .0003 


The Ige function returns the Kalman filter gains, K, for the equation: 


x= Ax + But Ky — Cx) (48) 


where x is an estimate of x. The Kalman gain matrix, K, is: 


0.0669 0 0 
0.0022 0 0 
0 0.0669 0 
K= (49) 
0 0.0022 0 
0 0 1.6069 
0 0 1.2910 


The output of the Kalman filter is the sum of the nonlinear low frequency system, in- 
cluding sampled values of position, heading, and wind velocity and direction, with the 
Kalman updates of position. The sampled wind velocity and direction data is trans- 
formed into ship’s coordinates and forces the vessel Kalman filter exactly, within sam- 
pling error, as the true wind forces the low frequency model. The optimal feedback gains 
are then used with the Kalman filter output to create the optimal Kalman filtered 


control: 
«* & 
u=K 


opi® (50) 


The reference error matrix, é, is defined by: 


A 
ry Tx 

A 
rex 
See 

eal (51) 

2 —= 
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The r values here represent the reference positions, heading, and associated velocities. 
The reference positions and heading are the desired location of the vessel. Since the 
desired location is to be maintained, clearly the reference velocities must be Zero. 

These optimal controls are then passed to a non-linear filter. This non-linearity is 
a limiter which prevents the thrusters and main propulsion from exceeding the maximum 
DP mode linuts (1.e., 12,000 /bf for main propulsion and 6,000 /bf for thrusters ). 

It is readily apparent that the control system as designed does not correct for the 
steady state error caused by the introduction of current. A modification to the control 


design to compensate for current offset is imperative. A Kalman filter predictor of 


20 


current is designed based upon the residual error in the vessel position estimator. That 
is, the difference in estimated and measured position and heading is assumed to be due 
to current. This is the “measured” value of the Kalman current filter. Recall the Kalman 
filter equation: 


X=AX+ But Ky — Cx) (52) 


For the current predictor filter: 


% 
it, 
A=] @ (53) 
v. 
be 
AL, 
xp—x 
VS || 2a ae yp (54) 
vr-w 
Op OO OO 
0 0 0 0 0 0 
OmOea: lO 20) 
A= (63) 
0 00 0 0 0 
OO LOO: OFT! 
00 0 0 0 0 
CO 20-07 0 
C= 0 1 0 (56) 
Om On OF I 
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The current estimator covariance matrices are: 


EL ww’ J. = 0.00002 (57) 
, oo 0 
En = | 023 CO (58) 
0 0 .005 


The current estimation filter gain matrix, K,, 1s: 


0.0140 0 0 
0.0044 0 0 
0 0.0140 0 
= (59) 
0 0.0044 0 
0 0 6.0000 
0 0 18.200 


The terms x;,y7, and ~; are the observations of surge, sway, and yaw including high 
frequency wave action and measurement noise. The estimates of current are converted 
to force terms by Bernoulli's equation and subtracted from the appropriate thruster 
control commands. Figure 5 shows the final system control design in block diagram 


form. * 
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Ficure 5. Control Sistem Design 


VY. COMPUTER SIMULATION 


The equations of motion and control system discussed in previous chapters were 
implemented using the Dynamic Simulation Language/VS (DSL). It 1s a high. level 
continuous simulation language developed by IBM which incorporates VS FORTRAN 
as a subset. The program is included in Appendix C here as an immediate reference. 
Comments are included as additional documentation. DSL was used here since it is a 
high level language which models the system in continuous time. Although the system 
is modeled as an analog system, DSL allows for the sampling of data as well. This 
sampling was used with the position, heading, and wind measurements, which were up- 
dated at 1 second intervals. Nearly all of the various models require Gaussian noise in- 
puts which are represented bv the NORMAL function. This function has inputs of seed 
number, mean, and standard deviation. One final word on DSL ts that it has its own 
plotting routine. System outputs presented here were printed using this plotting 


package. 
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VI. RESULTS 


The simulation results of the dynamically positioned buoy tender are shown here in 
a number of different environments. As discussed previously, the specifications for the 
desired dynamic positioning system are ambitious. To review, the vessel is to attain and 
maintain position to within a 10 meter radius in 30 knots of wind in any aspect and 5 
knots of current within 10 degrees of the bow. The initial test of the simulation is with 
no current, no wind, and at sea state 0. These conditions introduce the least amount 
of disturbance into the system. As can be seen from Figure 6, the vessel holds position 
in surge to within 5 feet. Similarly, Figure 7 and Figure 8 show the vessel holding sway 
position to within 5 feet and a decaying exponential response in yaw angle, with its 
maximum overshoot of 0.05 radians. In each graphical presentation of vessel position 
and heading, the true-measured position and heading are plotted along with the respec- 
uve vessel Kalman filter estimates. A position plot is shown in Figure 9. The position 
plot is presented as an “overhead” look at the vessel track in vessel coordinates. in order 
to obtain this vessel response, a conservative use of propulsive force is used, as witnessed 
in Figure 10 and Figure 11. 

The system is again simulated at sea state 0 with no wind and a current of 3 feet per 
second. In Figure 12 the system performance is observed in the surge direction. Since 
the vessel estimator is not forced by the current estimator, there is a bias introduced by 
the vessel estimator. This bias could be corrected by modifying the state variable matrix 


with the current velocities in surge and sway such that: 


x 


x=|j—¥ (60) 


This bias is exactly balanced in the propulsion scheme by the current estimated force. 
» Similarly, the system performance in sway, Figure 13, and yaw, Figure 14, is within the 


system constraints in the presence of this current. The position plot, Figure 15, closely 
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resembles its counterpart for the zero current case. However, the overshoot i both 
surge and sway is even more apparent in this plot. The transient performance is not of 
particular importance as the steady state performance is acceptable. Due to the cou- 
tinuing nature of the current disturbance, non-zero propulsive forces result in the steady 
state as scen in Figure 16 for main propulsion force and in Figure 17 for bow and stern 
thruster forces. 

The vessel when simulated at a current velocity of 4 feet per second does not inain- 
tain its desired position due to the steady state saturation of the bow and stern thrusters. 
The maximum current for which this system is effective is considered to be 3 feet per 
second. 

Since fully developed seas are correlated with wind velocity, the final simulation is 
at sea state 5 with current of 3 feet per second and 30 knot winds. With the addition 
of the Kalman predictor for current and the fact that wind is sampled each second and 
is incorporated into the vessel position Kalman filter, no great degradation in system 
performance is anticipated. The surge, sway, and vaw performance of the vessel can be 
seen in Figure 18, Figure 19, and Figure 20, respectively. The vessel response in surge 
and sway are well within the specifications. Although thers is no requirement to main- 
tain vessel heading, the steady state yaw response of the vessel is held to about 0.2 radian 
of the reference. The load on the propulsors under these conditions is heavy as can be 
seen in Tigure 21 and Figure 22. The position plot of the vessel under these conditions 
is seen in Figure 23. The steady state position is still within the vessel specifications. 

Although there is a degradation in system performance with increased environ- 
mental disturbances, the vessel is able to maintain a desired position to within the con- 


straints imposed at the outset. 
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Figure 6. Response in Surge: Sea state 0, No current, No wind. XT is measured 


surge position and XE is estimated surge position. 
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Figure 7. Response in Sway: Sea state 0, No current, No wind. YI 1s measured 


sway position and YE is estimated sway position. 
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Figure 8. Response in Yaw: Sea state 0, No current, No wind. PT is measured 


yaw angle and PE is estimated yaw angle. 
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Figure 9. Position Plot: Sea state 0, No wind, No current 
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Figure 10. Mfain Propulsion Force: Sea state 0, No wind, No current 
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Figure 11. Bow and Stern Thruster Forces: Sea state 0, No wind, No current. 
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Figure 12. Surge Response: Sea state 0, No wind, Current = 3 fps. XT is 


measured surge position and XE is estimated surge position. 
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Sway Response: Sea state 0, No wind, Current = 3 fps. YT is 


measured sway position and YE is estimated sway position 
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Figure 14. Yaw Response: Sea state 0, No wind, Current = 3 fps. PT is meas- 


ured vaw angle and PE is estimated yaw angle. 
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Figure 15. Position Plot: Sea state 0, No wind, Current = 3 fps 
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Figure 16.  Miain Propulsion Force: Sea state 0, No wind, Current = 3 fps 
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Figure 18. Surge Response: Sea state 5, Wind = 30 knots, Current = 3 fps. 
XT is measured surge position and XE is estimated surge position. 
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Figure 19. Sway Response: Sea state 5, Wind = 30 knots, Current = 3 fps. YT 


is measured sway position and YE is estimated sway position. 
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Figure 20. Yaw Response: Sea state 5, Wind = 30 knots, Current = 3 fps. PT 


is measured yaw angle and PE ts estimated yaw angle. 
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Sea state 5, Wind = 30 knots, Current = 3 
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Figure 22. Bow and Stern Thruster Forces: Sea state 5, Wind = 30 knots, Cur- 


rent = 3 fps 
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Figure 23. Position Plot: Sea state 5, Wind = 30 knots, Current = 3 [ps 
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VII. CONCLUSIONS 


This computer-based dynamic positioning system is a viable alternative to manual 
position keeping methods in environmental conditions of up to sea state 5, current up 
to 1.5 Knots, and wind up to 30 knots, particularly when precision requirements are 
deemed to be of greater importance than fuel cost. In order to meet the requirments for 
the new buoy tender fleet, bow and stern thrusters of 400 SHIP should be installed. 
These will allow the DP system to maintain vessel position and heading in the environ- 
ments specified. In addition, variable azimuth thrusters will provide enhanced control 


system performance over fixed tunnel thrusters. 
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APPENDIX A. STANDARD SHIP MOTION PROGRAM 


The added mass and drag coefficients for the 180 foot WLB “IRIS” class buoy 


tender are dimensionalized forms of the values presented here. 
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Figure 24. SSNIP Vessel Particulars 
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APPENDIX B. LODE SIMULATIONS 


The following are printouts from IODE programs. IODE (Interactive Ordinary 
Differential Equations) is an interactive software package that runs on the VM,CMS 
mainframe. IODE interrogates the user about the system of differential equations and 
provides the solution in tabular and/or graphical form. 

The first program of this appendix is a model of the low frequency vessel in surge. 
The vessel is modeled at full propulsive force, with no environmental disturbances. Us- 
ing the SMP value for vessel effective mass and the derived value for the drag coeflicient, 
the vessel is simulated in the open loop configuration and velocity plotted against time 
in Figure 26 on page 50 The LODE program listing 1s: 


VARIABLES & INITIAL CONDITIONS: 


X= .0 

Mos. @ 

rs oC 
CONSTANTS: 

NX = 71920. 00000 
NS = © 

DX = 169. 0000000 
FWX = .0 

uc = .0 


U = 20250. 00000 


SPECIAL FUNCTIONS: 
CC = XD-UC 


DERIVATIVES: 
NOSE AU) 
XD 


D(XD /D(T ) = = 
NX+( U+FWX-DX**ABS(CC )*CC) /MX 


OUTPUTS: 
TITLE: SURGE NO FEEDBACK 
NO TABULATION 


PLO Xx xD 
AGAINST: T 
Ore 240) 
AGAINST: T AT INTERVAL . 2000000000 


48 


= 


= xD 


0 .Q00E+00 Ses m5710) ie 150. 
=-+--------- + -wo--- =e $--=------ +oo------- $--------- +---~----- 4—-------- +--------- +-- 

10.9 MEU 0 ne cee oS ott) 
ee aa ee MM NU et ay 7 | 
! ar eC eee ON Nea aoe ! 
| f 
| I 
| I 
| | | 
| 
| I 

/ A Tse | + * 9:11 
: | I 
| | | 
7 | ] 
| I 
/ { | 
I 
I ! | 
| 

7.29 + 7.29 


——-——+ 








9. 0CoE+o0+ 
7 Q.oCcE-+00 
SURGE NO FEEDBACK 





Figure 26. Surge Motion with No Feedback 
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As in the first stmulation, the low frequency sway of the vessel is modeled in the 
open loop and velocity plotted against time in Figure 27 on page 51. The IODE pro- 


gram for sway 1s: 


VARIABLES & INITIAL CONDITIONS: 


Yeu 

is 0 

T=.0 

CONSTANTS: 

MY = 147615. 0000 

DY = 869. 0000000 

FWY = .0 

vc = .0 

FT = 12000. 00000 

NY = .0 

SPECIAL FUNCTIONS: 

CC = YD-VC 

DERIVATIVES: 

DY /D(T ) == 
YD 

D(YD /D(T ) = = 


NY+( (FT+FWY-DY*ABS(CC)*CC) /MY) 


OUTPUTS: 
TITLE: SWAY NO FEEDBACK 
NO TABULATION 
PLOT: YD 
“AGAINST: T AT INTERVAL . 2000000000 


END CALCULATION WHEN T .GE. 150.000 
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Figure 27. Sway Motion with No Feedback 


Finally, the vaw motion of the low frequency model is simulated in the open loop 


mode and heading angle rate plotted against time in Figure 28. 


VARIABLES & INITIAL CONDITIONS: 


P= .0 

PD = .0 

pS 0 

CONSTANTS: 

NP = 267000000. 0 

DP = 1170000000. 

NP = .0 

NW = .0 

Mo = 0 

NT = 954000. 0000 

DUM = .0 

DERIVATIVES: 

Hy it 3 == 
PD 

D(PD /D(T ) = = 


NP+(NTI+NW+NC-DP*ABS( PD)**PD) /NP 


OUTPUTS: 
TIE: PS 1 DOr 
NO TABULATION 
PLOT: PD 
AGAINST: T AT INTERVAL . 2000000000 


END CALCULATION WHEN T .GE. 150.000 


0.000E+00 37.5 75.0 ; 150. 
w-t------- = $oecennoee geeeenne-- tonne eenne gencenn--- tenen----- ten-n----- $e-------- +o- 


855E-02+ -855E-02 


. S80E-02 


$e 4¢ — 


-90GE-02 


G28E-02 -428E-02 


ee eg eg ee 4 ee ee ee = § = = = 


ONES 


I 
I 
| 
| 
| 
I 
| 
+ 
| 
I 
| 
I 
I 
| 
| 
| 
I 
+ 
I 
| 
| 
| 
| 
| 
| 
| 
| 
+ 
| 
| 
| 
| 
| 
| 
| 
| 
| 
+ 


.000E+00 -000E+00 
T 0.00CE+00 


PSI DOT 





Figure 28. Yaw Motion with No Feedback 
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APPENDIX C. 


The following is a listing of the DSL 


ronment, and the dynamic positioning control 


PROGRAMI LISTING 


system. 


program which simulates the vessel, its envi- 


Comments are mcluded 


throughout to augment the explanations provided in the body of the thesis. 


DEVELOPED BY W.R. CAIRNS, LCDR, USCG FOR THESIS RESEARCH: 
*""DESIGN AND SIMULATION OF A DYNANIC POSITIONING SYSTEM FOR A U.S. 


*COAST GUARD BUOY TENDER" 
TITLE: DPSINS 


“THIS PROGRAM SINULATES A WLB "IRIS" CLASS USCG BUOY TENDER SUBJECT TO 
*WIND, CURRENT, AND WAVE FORCES AND CONTROLLED BY A DYNAMIC POSITIONING 


*SYSTEN 


*THE PROGRAM PARANETERS (PARAM) ARE DEFINED AS: 
* FI,F2,F3 ARE THE VESSEL EFFECTIVE WIND AREAS IN SURGE,SWAY, AND YAW 
* A1,A2 ARE THE VESSEL WIND VELOCITY AND DIRECTION FORCE COEFFICIENTS 
* RX,RY,RP ARE THE REFERENCE POSITIONS IN SURGE,SWAY AND YAW 


PARAN F1=2, 294,F2=11, 16,F3=474.3,... 
A1=0. 001,A2=0. 001,... 
W=00.8,... 

IWVS=30.0,... 
IWDS=0. 0,... 
XCI=0.0),.... 
YCI=0.0,.. 
PCI=0.0,... 
Ri=100,0.... 
RY=100.0,... 
RP=1. 00 

TIE CONSTANTS (CONST) ARE DEFINED: 

%* X0,XDO INITIAL 

%* YO,YDO INITIAL 

* PO, PDO INITIAL 

* MX,DX MASS AND 

* MY,DY MASS AND 

** MP, DP MASS AND DRAG COEFFICIENTS IN YAW 

** NX,UX,SX SEED,MEAN,STD DEVIATION FOR LF 

* NY,UY,SY SEED,NMEAN,STD DEVIATION FOR LF 

* NP,UP,SP SEED,NEAN,STD DEVIATION FOR LF 


PLANT NOISE IN 
PLANT NOISE IN 
PLANT NOISE IN 


% HNX,HUX,HSX 
* HNY, HUY, HSY 
* HNP ,HUP,HSP 
* NWX,UWX, SWX 
%* NWY,UWY, SWY 
* NWP,UWP,SWP 
** MNX,UNX, SMX 
* MNY,UMY,SNY 
%* MNP,UMP,SNP 
= ONS CUKGes 
* CNY, CUY,CSY 
*% CNP,CUP,CSP 
%* NCX,MCX, SCX 


SEED ,NEAN, STD 
SEED, MEAN, STD 
SEED ,NEAN, STD 
SEED, MEAN, STD 
SEED ,NEAN, STD 
SEED ,MEAN, STD 
SEED ,MEAN, STD 
SEED , NEAN , STD 
SEED ,MEAN, STD 
SEED, NEAN, STD 
SEED , MEAN , STD 
SEED ,MEAN, STD 
SEED ,MEAN, STD 


DEVIATION 
DEVIATION 
DEVIATION 
DEVIATION 
DEVIATION 
DEVIATION 
DEVIATION 
DEVIATION 
DEVIATION 
DEVIATION 
DEVIATION 
DEVIATION 
DEVIATION 
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FOR 
FOR 
FOR 
FOR 
FOR 
FOR 
FOR 
FOR 
FOR 
FOR 
FOR 
FOR 
FOR 


HF 
HF 
Hp 
HF 


CURRENT 
CURRENT 
CURRENT 
CURRENT 


PLANT NOISE 
PLANT NOISE 
PLANT NOISE 
FREQ NOISE 
FREQ NOISE 
FREQ NOISE 
MEAS NOISE 
MEAS NOISE 
MEAS NOISE 
NOISE 
NOISE 
NOISE 
NOISE 


CONDITIONS FOR SURGE VELOCITY AND ACCELERATION 
CONDITIONS FOR SWAY VELOCITY AND ACCELERATION 
CONDITIONS FOR YAW VELOCITY AND ACCELERATION 

DRAG COEFFICIENTS IN SURGE 
DRAG COEFFICIENTS IN SWAY 


SURGE 
SWAY 

YAW 

IN SURGE 
IN SWAY 
IN YAW 
SURGE 
SWAY 
YAW 
SURGE 
SWAY 
YAW 
SURGE 
SWAY 
YAW 
SURGE( KALNAN) 


se 


we 


NCY MCY,SCY SEED,MEAN,STD DEVIATION FOR CURRENT NOISE IN SWAY (KALINAN) 
NCP,MNCP,SCP SEED,NEAN,STD DEVIATION FOR CURRENT NOISE IN YAW (KALMAN) 
NWVS ,UWVS ,SWVS SEED,MNEAN,SD FOR SLOW WIND VELOCITY NOISE 

NWVF ,UWVF ,SWVF SEED,NEAN,SD FOR FAST WIND VELOCITY NOISE 

NWDS ,UWDS,SWDS SEED,NEAN,SD FOR SLOW WIND DIRECTION NOISE 

MyDF ,UWDF ,SWDF SEED,MEAN,SD FOR FAST WIND DIRECTION NOISE 

FPR,FPL PROPULSION LIMITER (+/-) 

BTR,BTL BOW THRUSTER LINITER (+/-) 

STR,STL STERN THRUSTER LIMITER (+/-) 

EXD,EXU DEAD SPACE IN SURGE 

EYD,EYU DEAD SPACE IN SWAY 

EFD,EPU DEAD SPACE IN YAW 

RXD,RYD,RPD REFERENCE VELOCITIES IN SURGE, SWAY, YAW 

K VESSEL KALNAN FILTER GAINS SUBSCRIPTED ACCORDING TO MATRIX 

C CURRENT ESTIMATION FILTER GAINS SUBSCRIPTED ACCORDING TO MATRIX 

G OFTINAL FEEDBACK GAINS SUBSCRIPTED ACCORDING TO MATRIX 


CONST X0=0.0,XDO0=0.0,... 


YO=0.0,YDO=0.0,... 
PO=0.0,PDO=0.0,... 
MX=71920. 0,DX=169. 00000,... 
NY=147615. 0,DY=869. 0000,. 
MP=2. 67D+08,DP=1. 17D+99,... 
Mi=19. 0,00. 0.SX=0. 0005,... 
WW=2 120 ,UY—0. 0,5Y=0,0005,... 
NP=23. 0,UP=0. 0,SP=0. 00001,... 
HNX=19. 0 ,HUX=0. 0,HSX=3.0,... 
HNY=21. 0,HUY=0. 0, HSY=3.0,... 
HNP=23. 0, HUP=0. 0,HSP=0.175,... 
NWX=19. 0,UWK=0. 0,SWX=0. 005,... 
NWY=21. 0,UNY=0. 0,SWY=0. 005,... 
NWP=23. 0,UWP=0. 0,SWP=0.000175,... 
NNX=19. 0 ,UNX=0. 0,SMX=3. 0000,... 
MNY=21. 0,UMY=0. 0,SMY=3.0000,... 
MtP=23. 0,UNP=0.0,SNP=0.0175,... 
@-19. 0, 00=0. 0,CSX=0.00050,... 
Gr =21. 0, CUr=0NOneai=0. 00050,... 
CNP=23. 0,CUP=0. 0,CSP=0. 00001,... 
ee ee oe) 0005... 
NEY=21. 0, NCY=0. 0, SCY= Se 
POP=23, a NCP=0. 0,SCP=0. 00001, 
NWVS=19. 0, UNVS=0. 0, SHVS=0. 0005, 
WVT=21. 0 ,UWVF=0. 0, SWVF=0. 0005, 
NWDS=23. 0,UWDS=0. 0,SKDS=0. 00001,.. 
NWDF=23. 0, UWDF=0. 0,SWDF=0. 00001,... 
WNN=15. 0, VNU=0. 0, VNS=0. 0005,... 
FFR=12000. 0,FPL=-12000.0,... 
BTR=6000. 0, BTL=-6000. 0,... 
STR=6000. 0,STL=-6000. 0,... 
R-070 hvD-0. 0,RPD=0.0,... 
Rigeon0eso) £12-0, 0,K13=0.0,... 
ee) 00224he2-0,0723=0.0,... 
K31=0. 0,K32=0. 0669 ,K33=0.0,... 
ko 0), 62-00022,K43=0. 0,... 
i 54-0105 52-0. 0,K53=1.6069,... 
Reto 0 2-0. 0).K63=1. 2910,.... 
G11=0. 012;012=0. OMed3=0. 0,. 


C21=0. 0044 ,C22=0. 0,C23=0.0,.. 

C31=0. 0,C32=0. 014,C33=0.0,... 

C41=0. 0,C42=0. 0044 ,C43=0.0,... 

C51=0. 0,C52—n0)08055=6, 0000 ae 

C61=0. 0,C62=0"0 5316. 200) 

G11=193. 0,G12=5701. 00,G13=0. 0,G14=0. 0,G15=0. 0,G16=0. 0, 

G21=0. 0,G22=0. 0,G23=150. 0,624=4434. 0,625=24962. 0,626=24962. 0,... 
G31=0. 0,632=0. 0,G33=193. 0,G34=5701. 0,G35=-19415. 000,G36=-19415. 00 


: G11578. 50,G12=9200. 00,G13-07 0), 614-070, 615-0, 0, G16=0) 0h 

= G21=0. 0,G22=0. 0,G23=42. 00,624=7200. 0,G25=5854. 0,G26=8200.0,... 
a G31=0. 0,G632=0. 0,633=38. 0 ,G34=6900. 0,G35=-4553. 000,G36=-7500. 00 
* G11=77. 46,612=3335. 50,G13=0. 0,G14=0. 0,G15=0.0,G16=0.0,... 

¥ G21=0. 0,G22=0. 0,G23=47. 556,G624=2483. 80,G25=249. 62 ,G26=136.7,... 
¥ G31=0. 0,G32=0. 0,633=61. 14,634=3193. 40,G35=-194. 150,G36=-106. 34 
DYNANIC 


*LOW FREQUENCY MODEL PLANT NOISE IN SURGE, SWAY, AND YAW 
NOIX=NORMAL(NX ,UX, SX) 

NOLY=NORMAL(NY ,UY,SY) 
NOIP=NORNAL(NP,UP, SP) 

%*HIGH FREQUENCY MODEL PLANT NOISE IN SURGE, SWAY, AND YAW 
HNOIX=NORNAL(HNX , HUX , HSX) 
HNOIY=NORMAL(HNY , HUY, HSY) 
HNOIP=NORNAL( HNP , HUP , HSP ) 

“MEASUREMENT NOISE IN SURGE, SWAY, AND YAW 
MNOIX=NORNAL(NNX, UNX, SMX) 
NNOIY=NORMAL(MNY, UMY, SY) 
NNOIP=NORMAL( MNP, UMP , SNP) 

*CURRENT NOISE IN SURGE, SWAY, AND YAW 
CXNOI=NORNAL( CNX , CUX, CSX) 
CYNOI=NORNAL( CNY , CUY ,CSY) 
CPNOI=NORMAL( CNP , CUP, CSP) 

“KALMAN FILTER CURRENT NOISE IN SURGE, SWAY, AND YAW 
KCX=NORMAL( NCX , MCX, SCX) 

KCY=NORMAL(NCY ,MCY ,SCY) 
KCP=NORMAL( NCP , NCP, SCP) 

“WIND NOISE (SLOW/FAST VARYING)(VELOCITY AND DIRECTION) 
WVNS=NORMAL(NWVS , UWVS,, SWVS) 
WVNF=NORMAL( NWVF , UWVE , SWVF) 
WDNS=NORMAL( NWDS , UWDS , SWDS) 
WDNF=NORMAL( NWDF , UWDF , SWDF) 

*ESTINATOR ERROR - INNOVATIONS IN SURGE, SWAY, AND YAW 
INX=XT-XE 
INY=YT-YE 
INP=PT-PE 

*CURRENT CORRECTION (AS APPLIED TO LF VESSEL MODEL) 
Q1=XD-UC 
Q2=YD-VC 

*THRUSTER FORCE = BOW THRUSTER + STERN THRUSTER 
FT=BT+ST 

*BOW THRUSTER CONTROL 
BTI= G21*EX+G22*EXXD+G23*EY+G24*EYYD+G25*EP+G26*EPPD 
BT1I=BTI -( DY**( VCH) *ABS( VCH) +FWYS ) 

* BTII=BT1-FWYS/2. 0 
BT=LINIT( BTL, BIR, BTI1) 

*STERN THRUSTER CONTROL 
STI= G31*EX+G32*EXXD+G33*E Y+G34*EYYD+G35*EP+G36*EPPD 


STII=STI -( DY*( VCH )**ABS(VCH)+FWYS) 
x STII=STI-FWYS/2. 0 
ST=LINMNCSIL, SUR STIL) 
*PROP CONTROL 
FPI= G11°EX+G12*EXXD+G13*EY+G14*EYYD+G15*EP+G16*EPPD 
FPII=FP1-( DX*UC*ABS(UCH)+0. 75**FWXS) 
* FPII=FPI-FWXS 
FP=LIMIT(FPL,FPR,FPI1) 
*MOMENT CONTROL 
NT=78. 88*BT-81. 12*ST 
SAMPLE 
*TOTAL VESSEL NOTION MODEL - MEASURENENTS IN SURGE, SWAY, AND YAW 
XT=X+XH+NNOIX 
YT=Y+YH+MNOLY 
PT=P+PH+NNOIP 
*SAMPLED WIND FORCES AND MOMENT IN SURGE, SWAY, AND YAW 
FWXS=FWX 
FWYS=FWY 
MWS=MW 
DERIVATIVE 
%TO0W FREQUENCY VESSEL MODEL 
*LF SURGE 
K=INTGRL( XO, XD) 
XD=INTGRL( XDO, XDD) 
XDD=NOIX+( FWX+FP -DX*Q1*ABS(Q1)+N¥*Q2*PD+MX*VC%PD ) /MX 
*LF SWAY 
Y=INTGRL(Y0, YD) 
YD=INTGRL( YDO, YDD) 
YDD=NO1Y+( FWY+FT-DY*Q2**ABS( Q2 )+NY*UC*PD+NX"Q1*PD) /MY 
*LF YAW 
P=INTGRL(PO.PD) 
PD=INTGRL( PDO, PDD) 
PDD=NOIP+( -(MY-MX)**Q1*Q2-DP*ABS( PD )*PD+NC+MW+NT) /MP 
*HIGH FREQUENCY VESSEL MODEL 
*HF SURGE 
XH=INTGRL(0. 0, XHD) 
XHD=INTGRL(0. 0, XHDD) 
XHDD=-(WX***2 )?*XH+HNOIX-. 2**XHD 
“HF SWAY 
YH=INTGRL(O. 0, YHD) 
YHD=INTGRL(0. 0, YHDD) 
YHDD=-(WY***2)**YH+HNOLY-. 2**YHD 
“HF YAW 
PH=INTGRL(0. 0, PHD) 
PHD=INTGRL(0. 0, PHDD) 
PHDD=- (WP?'*2)*PH+HNOIP-. 2%*PHD 
*HF WAVE FREQUENCY VARIATION MODEL 
* FREQUENCY IN SURGE 
WX=INTGRL(W ,WXD) 
WXD=NORMAL( NWX, UWX, SWX) 
*FREQUENCY IN SWAY 
WY=INTGRL(W,WYD) 
WYD=NORMAL(NWY , UWY , SWY) 
*FREQUENCY IN YAW 
WP=INTGRL(W ,WPD) 
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WPD=NORNAL( NWP, UWP, SWP) 
*CURRENT MODEL IN EARTH COORDINATES 
XCED=INTGRL(XC1,XCEDD) 
XCEDD=CXNOI 
YCED=INTGRL(YCI , YCEDD) 
YCEDD=CYNOI 
PCED=INTGRL( PCI , PCEDD) 
PCEDD=CPNOI 
*CURRENT MODEL IN SURGE, SWAY, AND YAW 
UC=XCED*DCOS( PT)+YCED*DSIN( PT) 
VC=-XCED*DSIN( PT) +YCED*DCOS( PT) 
MC=PCED 
*WIND MODEL 
*SLOWLY VARYING WIND VELOCITY 
WVS=INTGRL( IWVS , WVSD) 
WVSD=WVNS 
*RAPIDLY VARYING WIND VELOCITY 
WVF=INTGRLC0O. 0 ,WVFD) 
WVFD=A1*WVF+WVNF 
*SLOWLY VARYING WIND DIRECTION 
WDS=INTGRL( IWDS ,WDSD) 
WDSD=WDNS 
*RAPIDLY VARYING WIND DIRECTION 
WDF=INTGRL(0. 0 ,WDFD) 
WDFD=A2**WDF+WDNF 
*WIND ANGLE OF ATTACK 
BETA=WDS+WDF -PT 
*WIND FORCE EQUATIONS IN SURGE, SWAY, AND YAW 
FWX=-F 1*DCOS( BETA) *(WVS+WVF ) 2 
FWY=-F2**DSIN( BETA) **(WVS+WVF )***2 
MW=F 3**DSIN( BETA )**(WVS+WVE ) 2 
*KALMAN FILTER FOR VESSEL 
*VESSEL KALMAN IN SURGE 
EX=RX-XE 
EXXD=RXD-XED 
AXE=(-DX*(XED-0. )*ABS(XED-0. )+MY**(YED-0. )**PED+NX*0. *PED) /MX 
BXE=( FP+FWXS ) /MX 
XE=INTGRL(0. 0, XED) 
XED=INTIGRL(0. 0, XEDD)+K11**(XT-XE)+K12*( YT-YE)+K13*( PT-PE) 
XEDD=AXE+BXE+K2 1*( XT-XE)+K22*( YT-YE)+K23**(PT-PE) 
*VESSEL KALMAN IN SWAY 
EY=RY-YE 
EYYD=RYD~YED 
AYE=(-DY*( YED-0. )**ABS( YED-O. )+MX*(XED-0. )*PED+MY*0. *PED) /MY 
BYE=(FT+FWYS) /MY 
YE=INTGRL(0. 0,YED) 
YED=INTGRL(0. 0, YEDD)+K31*( XT-XE )+K32*( YT-YE )+K33*( PT-PE) 
YEDD=AYE+BYE+K4 1*( XT-XE)+K42**( YT-YE)+K43%(PT-PE) 
*VESSEL KALMAN IN YAW 
EP=RP~-PE 
EPPD=RPD-PED 
APE=(-( MY-MX)*(XED-0. )*(YED-O. )-DP*PED*ABS( PED) ) /MP 
BPE=(NWS+MT+0. )/MP 
PE=INIGRL(0. 0, PED) 
PED=INTGRL(0. 0, PEDD)+K5 1*(XT-XE)+K52*( YT-YE)+K53*( PT-PE) 
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PEDD=APE+BPE+K6 1*( XT-XE)+K62**( YT-YE)+K63*( PT-PE) 


*FILTER PREDICTION OF CURRENT OFFSET 
*CURRENT PREDICTION IN SURGE 


*CURRE 


*CURRE 


ve TR 


CONTRO 
NETHOD 
SAVE 1 


URLND 
GRAPH 
LABEL 
GRAPH 
LABE] 
GRAPH 
LABEL 
GRAPH 
LABEL 
GRAPH 
LABEL 
GRAPH 
LABEL 
GRAFH 
LABEL 
*GRAPH 
* LABEL 
*GRAPH 
* LABEL 
*GRAPH 
* LABEL 
*GRAFH 
*LABEL 
*GRAPH 
*LABEL 
END 
STOP 


CX=INX-XCH 
XCH=INTGRL( 0. 0,UCH) 
UCH=INTGRL( 0. 0 ,UCHD)+(C11*CX) 
UCHD=(C21**INX) 
NT PREDICTION IN SWAY 
CY=INY-YCH 
YCH=INTGRL( 0. 0, VCH) 
VCH=INTGRL( 0. 0, VCHD)+(C32*CY) 
VCHD=(C42*INY) 
NT PREDICTION IN YAW 
CP=INP-PCH 
PCH=INTGRL( 0. 0, PCHD) 
PCHD=INTGRL(0. 0, PCHDD)+(C53*CP) 
PCHDD=(C63*CP) 
ANSFORM BACK TO VESSEL COORDINATES 
NCH=PCHD 
L FINTIM=800. 0,DELT=. 10,DELS=1. 0 
RKSFX 
Pedee EN PPereny BT ST.i0,PobPskl,YT,PT,XE,YE.PE,XH ui Pie 
FWX,FWY,MW,XDD,XHDD,NC,UC,VC,UCH, VCH, INX, INY, INP, XED,YED, PED 
UC ,UCH , VC , VCH 
(GlgDE=TEK618) TINECUN='SEC") ,XT(UN='FT') ,XE 
CGl)x7 VS. TINE 
(G2,DE=TEK618) TINE(UN='SEC'),YT(UN='FT' ) ,YE 
(G2) YT VS TIME 
(G3,DE=TEK618) TINE(UN='SEC'),PT(UN='RAD' ) ,PE 
(G3) PT VS TIME 
(G4,DE=TEK618) TINE(UN='SEC' ),FP(UN='LBF') 
(G4) PROP CONTROL 
(G5 ,DE=TEK618) TINE,BT,ST 
(G5) THRUSTER CONTROL 
(G6 ,DE=TEK618) Y(UN='FT'),X(UN='FT') 
(G6) POSITION X VS Y 
(G7 ,DE=TEK618) XE,XED 
(G7) FHASE PLANE 
(G7 ,DE=TEK618) TINE,UC,UCH 
(G7) POSITION UC,UCH VS TIME 
(G8,DE=TEK618) TINE,VC,VCH 
(G8) POSITION VC,VCH VS TIME 
(G9 ,DE=TEK618) TINE, INX, INY 
(G9) ERROR RESIDUALS 
(G8,DE=TEK618) TIME,Y,YH 
(G8) HIGH AND LOW FREQUENCY SWAY 
(G9 ,DE=TEK618) TINE,P,PH 
(G9) HIGH AND LOW FREQUENCY YAW 
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